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FIG.19 

(PROCESS OF SEARCHING INITIAL DIVERGENCE COMPONENT FOR NORMAL GAIT) 



C ENTRY ) 



S200 



DETERMINE INITIAL STATES (STATES AT INITIAL TIME Ts) OF FOOT POSITION/POSTURE, ARM 
POSTURE AND BODY POSTURE ANGLE BASED ON NORMAL TURNING GAIT PARAMETER 



PROVISIONALLY DETERMINE INITIAL (TIMETs) BODY HORIZONTAL 
POSITIONAELOCITY CANDIDATE (Xs, Vxs) 



S202 



S204 



oo 



DETERMINE INITIAL BODY VERTICAL POSITIONAELOCITY (Zs, Vzs) 



S206 



GENERATE GAIT FOR ONE STEP USING DYNAMICS MODEL BASED 
ON NORMAL TURNING GAIT PARAMETER ON THE ASSUMPTION 
THAT (Xs, Vxs) AND (Zs, Vzs) ARE BODY'S INITIAL STATES 



S208 



S210 



CONVERT FINAL BODY POSITIONAELOCITY FOR GENERATED GAIT INTO VALUES 
(Xe. Vxe) SEEN FROM SUPPORTING LEG COORDINATE SYSTEM FOR NEXT ONE STEP 



BOUNDARY REQUIREMENT ERROR (errx, errv) = (Xs, Vxs) • (Xe, Vxe) | S212 



^li-Pr EXIT REPETITION LOOP ) 

errx AND errv FALL WITHIN ALLOWABLE RANGES? J 



DETERMINE A PLURALITY OF INITIAL VALUE CANDIDATES (Xs+ A Xs, Vxs), 
(Xs, Vxs+ A Vxs) IN THE VICINITY OF (Xs, Vxs) AND OBTAIN 
BOUNDARY REQUIREMENT ERRORS THEREFORE ON THE ASSUMPTION THAT 
THE CANDIDATES ARE INITIAL STATES OF BODY 



S216 



S218 



DETERMINE NEXT INITIAL VALUE CANDIDATE (Xs, Vxs) BASED ON BOUNDARY REQUIREMtNl 
ERRORS FOR (Xs. Vxs) AND INITIAL VALUE CANDIDATES IN T HE VICINITY OF (Xs. Vxs) 



DETERMINE INITIAL BODY HORIZONTAL POSITIONAELOCITY (XO, VO), INITIAL 
BODY VERTICAL POSITIONAELOCITY (ZO, VzO) AND INITIAL BODY POSTURE 
ANGLE AND ANGULAR VELOCITY AT ORIGINAL INITIAL TIME 0 



S220 



DETERMINE NORMAL TURNING GAIT'S INITIAL DIVERGENCE COMPO- 
NENT q[0] USING FORMULA: q[0] = XO + VO/co 0 



S222 



DETERMINE VALUE q", WHICH IS NORMAL TURNING GAIT'S INITIAL DIVERGENCE 
COMPONENT q[0] SEEN FROM CURRENT TIME GAIT'S SUPPORTING LEG COORDINATE 
SYSTEM, AND VALUE (ZO", VzO"), WHICH IS INITIAL BODY VERTICAL POSITIONAELOCITY 
SEEN FROM CURRENT TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM 
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FIG.40 

( PROCESS OF DETERMINING CURRENT TIME GAIT INSTANTANEOUS VALUE ) 



( ENTRY ) 



DETERMINE DESIRED FLOOR REACTION FORCE'S VERTICAL 
COMPONENT AT TIME t BASED ON GAIT PARAMETER 



S1000 



DETERMINE DESIRED ZMP AT TIME t BASED ON GAIT PARAMETER 



SI 002 



DETERMINE DESIRED FEET POSITIONS/POSTURES, REFERENCE BODY POSTURE 
AND DESIRED ARM POSTURES AT TIME t BASED ON GAIT PARAMETER 



SI 004 



CALCULATE TOTAL CENTER-0 F-G RAVITY VERTICAL POSITION SATISFYING 
DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 



SI 006 



CALCULATE BODY VERTICAL POSITION SATISFYING 
TOTAL CENTER-OF-G RAVITY VERTICAL POSITION 



SI 008 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmox] AT TIME t BASED ON GAIT PARAMETER 



S1010 



DETERMINE FLOOR REACTION FORCE'S MOMENT ALLOWABLE RANGE 
AT TIME t BASED ON GAIT PARAMETER 



S1011 



SI 01 2 



DETERMINE BODY HORIZONTAL ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION OF CURRENT TIME GAIT SO THAT MODEL MANIPULATION FLOOR REACTION 
FORCE'S MOMENT IS GENERATED ABOUT DESIRED ZMP AND THAT FLOOR REACTION 
FORCE'S HORIZONTAL COMPONENT Fx DOES NOT EXCEED [Fxmin, Fxmax] 



CALCULATE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGULAR 
VELOCITY BY INTEGRATING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION, AND INTEGRATE THE RESULTING VALUES 
TO DETERMINE BODY HORIZONTAL POSITION AND BODY POSTURE ANGLE 



SI 01 4 



C RETURN ) 



